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A new class of ,-xponenc lally stabilizing control laws for joint level control of robot arms Is Introduced. 

It has been recently recognized that the nonlinear dynamics associated with robotic manipulators have certain 
Inherent passivity properties. More specifically, the derivation of the robotic dynamic equations from the 
Hamilton's principle gives rise to natural Lyapunov functions for control design based on total energy 
considerations. Through a slight modification of the energy Lyapunov function and the use of a convenient 
lemma to handle third order terms In the Lyapunov function derivatives, closed loop exponential stability for 
both the set point ar.d tracking control problem Is demonstrated. The exponential convergence property also 
leads to robustness with respect to frictions, bounded modeling errors and Instrument noise. In one new design, 
die nonlinear terms are decoupled from real-time measurements which completely removes the requirement for 
on-line computation of nonlinear terms In the controller Implementation. In general, the new class of control 
t laws offers alternatives to the more conventional computed torque method, providing trade offs between 
robustness, computation and convergence properties. Furthermore, these control laws have the unique feature that 
they can be adapeed In a very simple fashion to achieve asymptotically stable adaptive control. 

1. Introduction 

The problem of Joint level control tor the multi-link rigid articulated robot arm is addressed in this paper. 
Accurate measurements of the Joint variables, either angular or displacement, and the Joint velocities are 
assumed available. Traditionally, this problem has been treated by the PID algorithm. Since the justification 
of using PID control is based on either linear izat ion or some local stability argument [1], its application 
is limited to small angle maneuvers. Large excursions usually require partitioning a desired trajectory into 
intermediate points and PID control is used to drive the arm between adjacent points. This approach is less than 
satisfactory since global stability and adequate performance are not guaranteed. This then motivates the 
computed torque method [ 2 J which compensates for nonlinear terms in the robot dynamics. Assuming that the robot 
dynamics are known exactly, the compensated system apoeara like a decoupled system of double integrators and 
the closed loop dynamics can be shaped into desirable forms. 

A different approach has been advanced in the past few years. It is based on the recognition chat robot arms 
belong to the class of natural systems, which means time invariant, unconstrained and lying in a conservative 
force field [3]. It is natural to investigate if the structure specific to this class of systems can be 
exploited in controller design. It has long been known [3,4 and earlier] that negative proportional (generalized 
position) and derivative (generalized velocity), or equivalently PD, feedback globally asymptotically stabilized 
natural systems. The stability analysis is based on a Lypaunov function motivated by total energy considerations. 
Application of this result to robot arms has been relatively recent. In particular, global asymptotic stability 
under Joint level PD feedback with gravity compensation has been shown [5-8]. Application to the tracking problem 
is more difficult due to the time varying nature of the problem. More specifically, the stability analysis 
requires a generalization of the invariance principle to time-varying 3ystera9; this issue has been partially 
addressed in [9-10]. 

In this paper, we will introduce a new class of exponentially stabilizing control laws for both the set point 
and tracking control problems. The stability proof is achieved by making use of a particular class of energy-like 
Lyapunov functions in conjunction with a useful lemma for addressing the higher order terms in the Lyapunov 
function derivatives. In the set point control case, Lyapunov functions based on various artificial potential 
fields are used to derive control laws possessing desired properties. These include set point controllers having 
simple PD or PEH*blas structures and the ability to handle Joint stop constraints. In the tracking control case, 
this new class of Lyapunov functions avoids the need for a generalized invariance principle, which, as mentioned 
above, has been the major source of difficulty in existing approaches. This leads to a new class of exponentially 
stabilizing tracking control laws. In one design among this' new class, the nonlinear terras are decoupled from 
real-time measurements which completely removes the requirement for on-line computation on nonlinear terms in 
the controller implementation. This result is believed to have no counterpart in the present day literature. In 
general, the new class of control laws offers alternatives to the more conventional computed torque method, 
providing tradeoffs between robustness, computation and convergence properties. Furthermore, these control laws 
have the unique property that they can be adapted in a very simple fashion to achieve asymptotically stable 
adaptive control. This last property will be elaborated on in the companion paper [13]. The closed loop 
exponential stability also allows the robustness property to be established with respect to viscous and Coulomb 
friction, bounded modeling error and instrument noise. 
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This paper Is organized as follows: Some background derivations, Identities, notations, lemmas and relevs 

results In the literature are covered In Sec. 2. Several useful set point controllers based on different arti- 
ficial potential energies are presented In Sec. 3. A new Lyapunov function Is also Introduced to demonstrate 
exponential convergence. In Sec. 4, a new family of exponentially stabilizing tracking control laws era derive 
We will discuss the trade off between the ease of Implementation and the strength of assumptions for these 
controllers. Their robustness properties are also analyzed In this section. Finally, conclusions are drawn 
In Sec. 5 together with a table sumarlzlng all of the controllers presented In this paper and the conditions 
for stability. Due to the size limitation of this paper, the detail derivations are given in . 

2. Background 

2.1 Robot Dynamic Equation 

In this section, the dynamic equation of robot manipulator Is derived. At the first glance, It appears 
as a complex, tightly coupled set of nonlinear equations. However, based on derivation from Hamiltonian 
principle, the nonlinearity actually contains a great deal of structure. As a result, some Important 
identities are developed In the next section on which the rest of the paper Is based. 

An n-llnk rigid robot arm belongs to the class of so-called natural systems with the kinetic and 
potential energies given by 

T * Y 1 2 T m <» 1 > < 12 

T (2.1) 

U - - q 2 u + g(q r ) 

where 

T * kinetic energy , U ■ potential energy , q^ • Joint angle or position vector c R n , 

q 2 » Joint velocity vector c R n , MCq^ « mass Inertia matrix e R nxn , gCq^) * gravitational potential energy , 
u “ Joint torque force vector e R n 

Note that since all the analysis Is done at Joint level, the arm can be redundant (more than 6 Joints). 

To derive the differential form of rhe robot dynamics, first set up the Lagrangian 


Then apply the Lagrange's Equation 

i- (ii-) - li- . o 

dt 3q : 


This gives che dynamic equation of robot motion: 


M^)^ " - C(q 1 ,q 2 )q 2 - Mq^ + u 


c < V q 2 ) * j IC, q 2 VV> T - I (e i l 2 T V"l»l 


e^ - 1th unit vector 


3g(q,) 

k(q.) ' Tn" ' 

1 3q u 

q. ■ ith component of q. 

A 1 1 

The Cerm C(q^,q 2 )q., represents the Coriolis and centrifugal forces and k(q 2 ) represents the gravity load. 
Note that C(q 2 , q 2 ) Is determined entirely from the mass- inertia matrix. Many desirable properties, for 
example. Inherent passivity, well-posedness of solution (no finite escape under any bounded control), 
existence of solution to optimal control problem [1*] etc. are the consequence of this additional structure. 
Other impo'rtant properties of (2.2) Include that M(q 2 ) and M^(q^) are symmetric and M(q 2 ) is positive 
definite, for all q 2 cR n . For later use, the matrices C(q 2 ,q 2 ) and M^(q 2 ) are Interpreted as R nxn valued 
function of two n-vectors (q 2 and q 2 ) and one n-vector (qjJ, respectively. 

2.2 Some Useful Identities 


Some key Identities that will be used throughout this paper and the companion paper [13] are derived 
In this section. First define some notations: 
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(2.4) 


n _ 

Mpfq^Z) - l M^q^z 

ft <V’2> ‘ IF M <<1> 

Jlly*) - ^ [(a t z T M i (q 1 » - (« t * T M 1 (q 1 )) T l 

r(4 1 .q 2 .q 2d > * $ H<V q 2> (q 2" q 2d ) * C(q l » q 2 >q 2 1 


(2.5) 

( 2 . 6 ) 
(2.7) 


^ld* q 2d " desired J° int position and Joint velocities 


■iq, 


a q. 


'id 


q, - q 


2d 


Again, Mjj and J are regarded aa R valued function of two n-vector arguments. 
T 

matrix, l.e., J+J ■ 0. 

Identity 1 

M(q 1( q 2 )* • M D (q 1 .*)q 2 

Identity 2 

C(q lf z)z - y (Hjjfqj^.z) - Jfq^.*))* 

Identity 3 

J(q 1 ,«) ■ ‘ W x) 

Identity 4 

M D T (q 1 .x)y * M D T (q I .y)x 
Identity 5 

rfq^.qj.qjj) ‘ \ i q2 T(J<< 'l ,q 2 )q 2d " M D <q l’ q 2d* , 2* 

- Aq 2 T (J( qi ,q 2d )q 2 - « D (q l’ q 2 )q 2d ) 

- | Aq 2 T (J( qi ,q 2 d )q 2d - 

- i Aq 2 T (J(q r q 2 )q 2 - VV'W'h 5 

Identity 6 

M D (q 1 .Aq 2 )q 2 - CCq^q^q, - y (J^.q^qy * M D (q l' q 2d )q 2 ) 

- M D (q 1 .iq 2 )q 2 - c(q 1>q2 )q 2 -y (J(q 1 .q 2d )q 2 - M D ( < 'i- q 2 )q 2d ) 

■ 1 <N D r <q r iq 2 > Aq 2 + M D T(q l’ q 2d )Aq 2 ' V q l ,q 2d )4q 2 + 

M D (q 1 ,Aq,)q 2 - C(q lt q 2 )q 2 - k (■ J ^ . q 2(J ) q 2d ‘ M D (q i 1 q 2 5 <1 2d ) 


( 2 . 8 ) 


Note that J la a skew symmetric 


(2.9) 

( 2 . 10 ) 

( 2 . 11 ) 

( 2 . 12 ) 

(2.13) 

(2.14) 

(2.15) 

(2.16) 


(2.17) 


- (^(qj.q.j) ' M t ,(q 1 .q 2d )) 4 q 2 + 7 M D T(q l’ aq 2 )aq 2 + 2 V q l’ 4q 2 )q 2d (2,18) 

‘ M D (q 1 .iq 2 )q 2 * C( qi ,q 2 )q 2 - y - M D (q l’ q 2d )q 2 ) 

-y (M D (q 1 ,iq 2 )-iq 2 +M D (q 1 . i q 2 )q 2d ) <2-19) 

2.3 Important Lemmas * : 


In this section, two Important stability lemmas are presented that will play pivotal roles In later 
sections. The first lemma Is essentially a local stability cheorem that establishes a region of convergence. 
The second lemma generalizes the first result to the Lagrange stability case. The proofs of these lemmas are 
given In [23] . 
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Lemma 2-1 


Given a dynamical system 


*1 ■ t) , * t c»“l ; t 10 

Let fi'e be locally Llpachlts with reapect to x x x N uniformly In t on bounded Intervale and contlnuoua 

In t for t 2,0. 

n.x. . .Xn„ 

Suppoae a function V:R x R + R + la given auch that 

N T 

V(x l V * 1> }. 1 x i P 1J <X 1 V t)x J * 

V la poaltlve definite In x^,...,^ 

V(x. x M , t) I (a, - l Y lj ||x.(t)l! kl ^)||x 1 (t)|| 2 (2-20) 

1 " le^ 1 jclj^ J 

where t^, Y^. kjj » 0, Ij C ^ C{1,...,M) 

Let > 0 be such 

« 1 II X 1 II 2 « V(x x v t) <2,21) 

Let V o 2 V(x^(0) x N (0). 0) 


If V 1 E I,, 




a l * E Y 11 ^ 2 
J 


j c1 2j J k 

H V X 11 

then V X. t (0, a. - l y.. (t^) 2 ), 

1 jcl 2i 

V (x 1 ,....x I|( t) < | |x t ] I 2 Vt>0 


In the above lemma, we choose to bound over l y,, | |x. ( t) | | 

l eI 2 t ^ J 


(Condition (2.20) reflects that choice). This choice Is arbitrary; in fact, we can extract any quadratic 
cross term from 

l y . , I|x.(t)|| k i3 | lx Ct) 1 1 2 
Jd 2l J J 

and overbound the rest. After completing square stability condition similar to (2.22) can be stated. 

Ue do not pursue this generalization here. 

Lemma 2-2 


Suppose in Leoma 2-1, 


V(x x ,t) i - I (a. - I Y Hx.|| k iJ) I |x | | 2 + 0 

1 N lel 1 1 j C I 2l J 1 


I x - (1 N) 

Let p - sup l|P(* 1 * N .Oll < “ . [Ply ■ P tJ 


x i ER n l,tER+ 


If H £ I. k 

V -5J- 

op . r / O , 2 (2.25) 

Bl> ^ ,J 2l YlJ V 

then 

. . 0 

limsup V (x^t) 3 ^(t),t) i. j ^2 26) 

C ~“ V 

, h .„ » - i ... (., - l ,y C^> > 

^ ^ i 2 0 

Furthermore, the convergence to the set { (Xj , . . . .x^) : } | x fc | | <_ j- j- , kcl 1 ) is exponential with rate X. 

i > *- *k J ' 
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Tha utility of thla roault la mainly In robuatnaaa analyala. Basically, given a bounded aat of 
poaalbla Initial conditions, excluding a neighborhood of tha origin, ai'a auat ba larga anough In tha 
aanaa of (2.23) for tha trajectories to ba unlforaly bound ad. What If V 8 « 07 Wa can ahlft t • 0 to 
aoaa flnlta tlaa latar whan Vt i 0* in praetlca, a naighborhood around origin can uaually ba excluded 
alnca aoaa robuat locally atabla control algorithm auch aa FID taka a over. 

2.4 Racant Raaulta 

Soaa of tha racant raaulta ralatad to Lyapunov analyala of robot ayataaa ara ravlawad In thla aactlon. 
For tha aat point control problaa, (3-10) haa applied tha raault that linear negative feedback of genarallaed 
poaltlon and valocltiaa globally aayaptotlcally atabllltaa a natural ayataa to robot aanlpulatora. Wa will 
raatata thla raault, mention work for tha tracking problaa In (9,10,18) and atate aoaa open laauea that 
will ba addressed In tha remainder of thla paper and In (13). 

Theorem 2-1 


Conaider (2.2) with tha control law 

u - - Kp 4 qi - K v q 2 + k( qi ) , Kp » 0. ^ » 0 (2.28) 

The null atate of (Aq^, q^) - ayataa la a globally aayaptotlcally atabla equilibrium. 

The main Idea of thla approach Is to shape the potential field In auch a way that It la globally convex 
and attains a global minimum at Aqj - 0. Complete damping (In the terminology of [3]) la added through the 
derivative feedback to drive the syatem to the minimum potential energy atate which by dealgn la Che 
desired state. To be specific, suppose the desired potential field is U*(Aq^). The total energy under 
this potential Is 


Rewrite V as 


V - T + U° U* - U° • V° + U* - U° 

where U° is the original potential energy without external force fields, and V° la the corresponding 
total energy. Let p - M(qi)qj be the generalixed momentum. From Hamilton's equation, 


,3V°T T/ 3U* 3U 

3P ) U +<, 2 ( 3Aq x ’ 3Aq 1 


T, . 3U* 

q, (u + 


3U 


3Aq. 3Aq, 


(230 ) 


Hence, co drive the desired total energy to its minimum state, we can select ((5)) 


K v q 2 3Aq. 3Aq. 


(2.31) 


Then V - 


2 

3 9i 


T K q,. From the fact that 4 * unlfornl y bounded (V ^ 0) , q 2 <t) - 0 as t - - (19). 


’2 " 
+ u 


3T 

3q, 


3U 

3<iq 1 


+ u 


3T 


-vo - 2IJi- 

v q 2 3Aq^ 


(2.32) 


„ . SU* 

Since - 0, — 


3T 


’9i 


3Aq, 


- 0, also. Hence, If U*(Aq^) ts globally convex with minimum at Iq^ • 0, Aq, (t) 


IT 

t - If U*(Aq 1 ) * y Aq^ k Aq^, Theorem 2-1 is immediately obtained. 


Obviously, any other potential field convex in Aqi that has global minimum at Aqf - 0 (and no local 
minima) can be used. We will use this idea in the next section Co address the joint stop issue. 


This control law la very appealing In its simplicity and obvious robustness with respect to 
modeling error in mass matrix, and centrifugal and corlolls terms. Generalization to the tracking 
problem is partially addressed in [9, 10). A control algorithm la given in (9), but it lacks stability 
analysis. In [10], Matrosov's Theorem [11] is used. A question remains on ths necessity and 
applicability of the Metrosov's Theorem to the tracking problem. One version of the tracking control law 
in Section 4 is the same as in [10], but the stability issue is resolved more completely. Nonadaptive 
version of the tracking control laws in [10, 18] do yield global asymptotic stability. However, the 
simple structure of (2.28) is lost; even for set point control, full model information is reeded. 
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Baaed on tha above very brief rcvlcv of the currently available pertinent reaulta, It la evident that the 
following laauea reaaln open: 

1. Can we get away with no gravity Inforaatlon, thua achieving a "unlveraal" (era Independent) act 
point control law? 

2. Coaputed torque achlevea exponential atablllty. Are echeaea baaed on energy Lyapunov functlona 
Inherently Inferior (e.g., only aayaptotlc atablllty la poaalble) or have we not been clever enough 
In chooalng the Lyapunov functlona? 

3. The tracking problea producea a tlae-varylng ayatea. Can the Invariance Principle atlll be applied? 

A. How far can we reduce the on-line coaputatlon requlreaent (thua allow lncreaalng performance) for 
both aee point and tracking probleaa? What la the price to be paid? 

3. Can we enaure any robuatnaaa propertlaa with reapect to friction, In a t rumen t no lee , modeling errora? 

6. How doea one incorporate Joint atop conatrainta? 

7. Would theae echeaea (aet point and tracking controla) atlll work If unknown paraaetera are adapted? 

The reat of thia paper will be devoted to anawering laauea 1-6. The laat ltea la addreaaed 
in {13] and [24]. 

2.5 Coaputed Torque from Lyapunov Perapectlve 

In Section 2.4, we Introduced the total energy Lyapunov function (2.29) to derive a a lap la aet point 
control law. The coaputed torque method can alao be motivated In the aaae manner with e different 
Lyapunov function. For generality, we will conalder the tracking caae. Let 

V(aq 1 .iq 2 ) - i||dq 2 || 2 ♦ j dqj K p ^ (2.33) 

Calculate derivative along aolutlon, 

V • Aq 2 T (M 1 (q 1 )(-C(q 1 ,q 2 )q J - kfq^ + u) - q^ ♦ K p Aqj) 

If the coaputed torque control la uaed 

u - k(q t ) + C(q 1 ,q 2 )q 2 * M (qjHq 2<J * U p 6q 1 * (2-34) 

then 

v i - i< ' 2 T Vq 2 

From the same line of reasoning as before, che closed loop system is globally asymptotically stable. 

However, we know that the closed loop system Is linear, therefore it is exponentially stable. This means 
that we should look for a better Lyapunov function. An obvious choice is to add in a cross term In 
(2.33). Then 


Vfaqj.aq^,) - i ||aq 2 (| 2 + j aq^flt + « K w )4q 1 + =4qj T 4q 2 (2.35) 

where c la small constant ao that V la positive definite. Take derivative and apply (2.14), 

V - - iq 2 T K v iq 2 + caq 2 T + cj|iq 2 || 2 - cflq^ - cAq^ 

' * (3 «ln <K v> - C) 1 1^1 1' * 'V V q l 
which shows closed loop exponential stability. 

Note that In (2.14), In contrast to (2.28), even for aet point caae, full model nonlinearity 
cancellation la needed. The approach In this paper la Co use the energy Lyapunov function Instead of 
(2.33) to generate control lawa. We will aee In later sections that thia affords a much larger 
claas of controls which contains much simpler structure In certain cases (especially for set point 
control). 


3. New Results on PD Set Point Control 


3.1 Simple PD Controls 

In this section, we will explore using different U* In the controller design 
suggested In (5): 

1 , T T 

* 2 ‘“'I V q l " ' * (q ld ) - iq l k(< >Id ) 
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The following has been 


UMiqj) 


(3.1) 


K is sufficiently large, iqj • 0 ii the global ■!»<— of U(Aqj). Hanes . a simpler control law can b« used: 


* - V<1 - V2 ♦ k ^id> 

Suppose each joint la constrained between joint stopa: 


•if! 5 iq„ iq 


(h) 

11 


■'ll - H li 

and the set point Is In the Interior of the joint Inputs: 


,<*) < 
'll i 


(h> 


-’lid * "U 


"11 111 
Let the desired potential function be 

n 


(3.2) 


(3.3) 


(3.4) 


(JJ) 


V(& qi ) - j 4, x T ♦ l x (H 1 (A, u+ , lld ) ♦ L 1 (A<, u 4, lld )) 
where and L^ are appropriate upper and lower barrier potential functions for joint 1 
iq^ • 0 la a global minimum of L'*(Aq 2 ) [23j . From (2.31) 
u • - K y q 2 - KpAqj - HfAq^) - L(4q 1 > ♦ k( qj ) 

.allarly, If K la aufflclently large (K ♦ ~ (4q t ♦ q ld > > 0). the following control law alao achieves 


(3.6) 


(3.7) 


Sla 

global asymptotic stability: 

u - - K v<l2 ‘ %% * "^l 5 ‘ ‘* (4<, 1 ) + k(q ld > 

Control laws (3.2), (3.6) and (3.7) still rcqulra Information on the grevlty load. It Is Interesting to 
ask If this last piece of aodel Information can be removed. This case corresponds to the desired potential 
energy 


^•(Aqj) * j 4qj T K p 4qj * gWqj+q^) 

The corresponding control law la 
u - - lOqj -K v 4, 2 
From section 2.4, 

(i qi ) . Kiq 1 ♦ k(4q l+ , ld ) - 0 
This implies 

1 lmsup | Uq.(t) 1 1 <_o (K ) *«P || k(q,)|| 

1 “ ln p q^t" 1 


(3.8 ) 


(3.9 ) 


’k(q,) 


If K + 
P 


* 0 Vq^cR , - Kpk(Aq^+q^) Is a contraction map In <iq^. Then 3 q^* 


such that 


VV _q id ) + k(q i 4) ' 0 o.io) 

11" q. (t) - q « 
t— . 1 1 

This result suggests a very simple, robust and practical control scheme. The feedback gain K can be chosen 

large enough to Justify the use of PID control (l, ch. 6 of 19) which la locally stable. p Typically, k(q ) 

3k(qj) 1 

and — jqq — arc composed of trigonometric functions, therefore, they are uniformly bounded. 

3.2 PD Control with Exponential Convergence Race 

Dee of the Invariance Principle In Section 2.4 only shows asymptotic stability. Some guaranteed rate of 
convergence Is highly desirable not Just fer performance reasons but for robustness analysis and adaptive 
control also. In Section 2.5, a Lyapunov function with cross term has been used to show exponentlsl 
stability. This suggests a similar modification here. The result Is summarized below. 
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Tlworw 3-1 

Glvtn the control law (2.31) 


. K 


JU« ^ 1U 


(2.31) 


» q 2 ' j qi + Jqj 

Suppoaa 3 v > 0 auch that 

^ > v h^h 2 o.ii) 

and U*(4qj) haa a global alnlaua at Aq^ - 0, than tha cloaad loop (Aq^.qj) ayataa la exponentially atabla. 
Proof : 

Modify tha total anargy Lyapunov function (2.29) to 

V - T + U* + cAqj T p t \ cflqj I^Aqj 

whara c la a aaall conatant ao that V la poaltlva daflnlte In p and qj. Without loaa of generality, U* can 
ba eonaldarad poaltlva definite In q^ (by adding an appropriate conatant). Than froa (2.32), 

V - * § ♦ « < 2 T P ♦ « V<- ^ « -I T V”! 


■ - « 2 t k v « 2 * « q 2 T M <V q 2 - c V % * c V ^7 


Let 


u s aup II M(q.)| | 

q^R" 


1 ' | 1 4 q" f : |./ U * <4q l > * 2 C4q l K v i, l " 2 Cjt2 ' * 0 tor conatant t. 
1 V 1 

From Lemma 2 -l, V ^ c (0, a, - y (j 2 )!) 

V 1 - * l .f;lAd 1 ll 2 - » 2 !Uq,l| 2 


Note 


^ * 5 j l 'l q 2 T W q 2 * W ( V q 


’ q 2 )q 2 


Then 


* - ' <0 aln < V ’ cu> l l a 2 H 2 * c v N0‘) 1 l I 2 - | *, X T N D T<q l ,q 2 ,<, 2 

Define 

n 

■ *up l | [M (q ) | | 
qj i-i 1 1 

VI - ijilAqjl ! 2 - ^Ihqjll 2 + YjjIlAqJI I Uq 2 l | 2 


Then 


where 


J i ’ c - 


' , < K > - cu 
min v 


Y . * 2 C ”l 

Choose ^ 

c ' ’am ( V (U ♦j n i 

where V - V I and 
° t-0 


(3.12) 

(3.13) 


(3.14) 


(3.15) 


(3.16) 
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< - X V 


for io«m > » 0. Hence, the closed loop system li oxponont tally atabla. 


f 


Clvan any U* according co (3.11), r > 0 and initial condition, thara always exists c that aatlaflaa 
(3.16). Evan though c la not needed In the implementation, lta maximum allowable alze affacta tha 
convarganca rata. Tha artificial pocantlala U* • 1/2 AqjT KpAqj, (3.1) and (3.5) all aatlafy tha 
aseumptlone of Thaoraa 3-1. Tharafora, tha corraapondlng cloaad loop ayateaa are exponentially atabla. 
For tha potantlal given by (3. 8 ) and Kp large enough ^ + 3k > qj, we can add a conatant to U* ao 

P Sq i 


that U* la poaltlve definite In q^-q* and (3.11) la aatlaflad for iq^q^qj, where qj aolvea (3.10)* Then 
Thaoraa 3-1 iapllea exponential convergence of q, to qf which la within 0 o i n (Kp) »up||k(q^)|| froa the true q^. 

q l 


4. New Reaulta In Tracking Control 
4.1 Exponentially Stable Algorlchaa 

Frequently a robot 1a required to follow a preapaclfled path for cont lnuoua action at the end effector 
(e.g. , arc welding), tracking of a moving target (e.g. pick and place operation from conveyer belt) or 
other high level objectives (e.g., time optimality, colliaion avoidance, arm singularity avoidance, etc.). 
Thla can be poaed aa the problem of tracking the dealred positions and velocities (qu, q 2< j) b y ^1><12^ - In 
this section, we will extend the basic Ideas put forth in Section 3 to the tracking problem. The error 
equation Is now in the form 

dqj • dflj 

fKqjJiqj * - Cfqj.qj^l; * Mgj) * u ‘ Mtq | >q 2 d <4-1) 

Ue will first state several direct generalizations of Theorem 3-1. An energy type Lyapunov function 
similar to (2.33) uoed in Section 2.5 to motivate computed torque is used here. 

Theorem 4-1 


Consider (4.1) with the control law 
u - - V q 2 * klqp - (A^) + M ( qi )q 2d - Olq^.q^) 

where D is given by any one of the following expressions 

D( W <, 2 d ) * 7 <J< V q 2 )q 2 d • M D (q r q 2 d )q 2 ) 

■ 7 (j(q l' q 2d )q 2 - V q l- q 2 )q 2d > 

° <q l' q 2 iq 2d ) ' 7 (J(q l' q 2d )q 2d ' VWW 
D(q r q 2’ q 2d ) ’ 7 <J( V q 2 )q 2 * WW 


(4.2) 


(4.2a) 


(4.2b) 
(4.2c) 
(4. 2d) 


Assume 3v > 0 such that 

aq l T (iq l ) ’ v I I q x l I 2 (4.3) 

and L'MAqj) is positive definite iniq^ Then the null state of the Ciq ,iq ) system is a globally 
exponentially stable equilibrium. 1 2 

Proof : I'se the following Lyapunov function 

V(- qi ..-q 2 ) - ± -q 2 T Mfq^iq, + UM.'.q^ ‘ C AqJ + \ C AqJ (4 ..) 

where c Is a small constant, such that V is positive definite in Aq, and Aq.,. Take derivative along 
solution: 1 

V (Aqj.Aq,) - Aq ^(M^ ) Aq 2 + | M [ 3 (q 1 ,Aq 2 )q 2 + (Aq^ + c MfqjiAq, 

+ c ^.Aq^ + c Aq 1 ? (M(q 1 )Aq 2 + M Q (q l , Aq 2 >q 2 ) 

Substitute (4-1) and (4.2) and use (2.7) 
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V(Aq lt 4q 2 ) « 4q J T (-C<q 1 .q 2 )q 2 - k(q 2 ) + “ - M <qi> q 2d + f M D (q l ,liq 2 )q 2 

+ 7S7 (4q i ) + c M(q i )4q 2 + c V V 

+ C Aq^C-^q^qjJqj - k^) + U - M^)^ + , Aq 2 )q 2 > 

- r(q 1 .q 2 ,q 2d ) - ^ “ cM < q i >> iq 2 " ,q 2 ,q 2d ) 

+ cAq^fMpU^Aq^qj - 

- !l^ <4q l> * CAq i T D < q l* q 2* q 2d ) 

Apply Identity 5, r - Aq 2 T D - 0. Define n 2 «• follow* 
n 

n, • «up I liMqJll 
1 q lE a n i-i 1 1 

n, - ««p lUjJIn,. 
q2d 

Froa Identity 6, 

l C4q l T(M D (q l’ M 2 >q 2 ' C(q l* q 2 )q 2 " D(q l >q 2 ,q 2d ) I 

i = I |fiq x I Konj l|fiq 2 1 1 ■*■ T" HM 2 il 2) 

where »-3 {or ( 4 , 2 *) , a-| for (A. 2b) , a»| for (A. 2c) , a-j for (A. 2d) 
Hence, 

V(Aq 1 .Aq 2 ) < - (o nln (K v ) - cp) ||Aq 2 || 2 - c v ||Aq 1 || 2 

+c | |Aq x | I (an 2 ! |Aq 2 | | + J^llAqj] | 2 ) 

Completing square for the cross term, 

VCAq^Aq^ «. - aj jAqJ | 2 - a 2 I I A< 1 2 1 I 2 + Y 2 1 1 I Aq l I ! I I Aq 2 1 ^ 


, 1 2, 

* c(v - j a Y ) 

1 an 2 

“2 - °«in ( V * = + 7 1 

0 

Y 21 ' 2 C n l 

2 2 “l 

Given j, choose 0 < . By Lemma 2-1, for 

an 2 

1 an -> 1 v „ I 

<<<WV (u + 2 -r + 2 n i <r )2) 

0 1 

(V , are as defined from the proof of Theorem 3-1) and V X- e (0,a. - y 21 
o 1 *• x ** 

V < - o 1 l|Aq i l| 2 - X 2 | |Aq 2 t | 2 


for some X > 0. Hence, the closed loop system Is exponentially stable. 

A common Lyapunov function used for tracking problem has been [9, 10) 
V(Aq 1> Aq 2 ) - J Aqj 1 Mfq^Aqj + U-fAq^ 


In this esse, a ganarallxation of Invarlanca Principle to tine-varying caae la required. There are two 
poaalbllltlea. The reault In (Theorem A. 7. 6, 21} appeara pronialng, but we auat verify that (4.1) la poaltlve pre- 
conpact (in the aence defined in [21]). A note direct route la to use [Lean* 1. 22] which states that If 
A$ 2 »nd A<?2 (c * both bounded unlforaly In t (It followa fron V ^ 0) , then Aq 2 (t) ♦ 0 lap 1 lee Aq 2 (t) •* 0. 

Note that U*(Aq 2 ) doea not depend on tine explicitly. Thla reatrictlon eliminates aoae of the 
candldatea uaed In aet point caae. How to generalize to the caae of U*(Aq 2 ,t) and 3U* (Aq ,t) not 
necasaarlly negative aealdeflnite la currently under inveatigatlon. 3 t 

Control lawa (4.2a-d) all have aame stability property nominally. When q 2 la a very nolae measurement, 
aa la typically the caae, (4.2c) which only uaea q 2 once nay have better robuatneaa. 


Note that all the controllera have atructures very alailar to computer torque; In fact, If all occurrencea 
of q 2d are replaced by q 2 , then tha nonlinear compensation la exactly the same as the caae of computer torque. 
However, In their present forms, (4.2a-d) cannot taka advantage of well known recursive algorithms for Inverse 
dynamics computation (11, 12]. Therefore, we next present slightly modified versions that can be Implemented 
with these algorithms. 

Corollary 4-1 

Consider (4.1) with the control law 

u - - V<»2 + k(<l l ) " 3^ <Aq l } + M(q l )q 2d + C( V q 2d )q 2d (4,6) 

satisfies the sane assumptions aa In Theorem 4-1. 


state of the (Aq^.Aq^) system la a globally exponentially stable equilibrium. 


(4.1) with the control law 

U - - K y Aq 2 + k(q r ) - ~~ (dq^ + Mfq^q.^ + C(q,,.q 2 )q 2 (4.7) 

where USfAq^) satisfies the assumptions as In Theorem 4-1. Civen a set of possible Initial conditions, If 
Ity Is sufficiently large, then the closed loop system Is exponentially stable with respect to that set. 

1 T 

If UsfAq^) ■ y Aq 2 K , (4.7) Is actually a modification of the computed torque method with K p , 

*v replacing MfqjIKp, M(q 1 )K y . 

So far we have generated many control laws that are similar to computed torque. However, the ones 
Just requiring 1^ > 0, v > 0 are not easily lmplementable, and the easily implementable ones need stronger 
conditions (Ky sufficiently large). The next control law that we shall present Is of very appealing 
structure: the real time undate comoutatlons are linear and the off-line computation can take 

advantage of efficient algorithms (c.g., Newton-Euler type). The trade-off Is that K v and v must both 
be large enough for a given set of initial conditions. 

Theorem 4-2 


where U*(Aq 1 ) 
If 


o , (K ) 
min v' 


then the null 
Corollary 4-2 
Consider 


Consider (4.1) with the control law 


* - v q i + 


k(q ld> • (Aq l ) + M(q ld )q 2d + C(q ld’ q 2d )q 2d 


(4.8) 


where U*(Aq^) satisfies Che assumptions as In Theorem 4.1. Given a set of possible Initial conditions, if iCy 
and v, are sufficiently large, then the closed loop system Is exponentially stable with respect to 
that set. 


Tvptcally, q 2 (0) * q 2d (0) * 0 and Aq^(0) Is always within 2s. Hence V 0 is bounded above, and the result Is 
essentially a global one. This scheme requires boch v and K v large enough. This requirement Is made easier 
by shifting the computational burden to offline thus allowing very high sampling rates which In turn means 
high gains can be tolerated. 

4.2 Robustness 


Lyapunov analysis provides a useful approach to study the robustness Issue. Robustness Is a much abused 
word In the literature. Here, we use Insensitive design to mean preservation of stability (In the sense of 
Lagrange) under sufficiently small perturbations. Furthermore, the size of the ultimate bound should vary 
continuously with the size of perturbations. By robust design we mean a controller design that preserves 
stability under prescribed size of perturbations. In this section, we will examine frictions, boch viscous 
and Coulomb type, bounded modeling error and bounded actuator and sensor noises. 
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Friction forces esn be epproxloately oodeled by Coulonb friction, or dry friction, and viscous friction 
due to oil lubrication. For Joint 1, the frictional force Is given by 

f mc • - 'll •«" «2i> - F 2t **21 • • F H* F 2i * 0 (4 - 9 > 

Equation (4.1) is then 

Mfqpiqj * * C(q 1 ,q 2 )q^ - k(q 2 ) + u - N(qj)q 2d - Pj xgn(q^ - Fjq 2 

where F 2 and F 2 are diagonal matrices with elements F^, F 21 , respectively, agn(q 2 ) represents a vector 
with elements egn(q 2i ). 

From [23], the set point controller la both lnsanaltlve and robust. The tracking controllers are also Insensitive 
with raepect to frictions. For robust design for a given level of friction, * n< * v ehould be chosen large 

enough. , 

Next we consider modeling error in controller implementation. Model parameters k, M, M D can all be 
written linearly In constant parameters. Assume bounded errors are Incurred In these parameters. 

Control laws (4.2) are In the form 

“ * ‘ V q 2 ' S 7 ( 4 q l > + “^l 5 + K<q l )q 2 d ‘ D(qi.q 2 .q 2d > + \ + * 2 

The additional terms in V are 

- (CAq t + Aq/ (A ; + Aj) 

which, aftar overbounding [23], becomes 


(c| |dqj | | ♦ I |Aq 2 l |) C 1 ! + S 2 + 4 j I I I + ^ I 1^ I | 2 ) 

After completing squares, the overbound over the extra terms In V become 

„ c‘ 


) 

! ( V 3 2 + -tx-> »V 


♦ < S 3 + - V * -^-1 > l ! Aq 2 H 2 
2S 1 2 *2 


+ C4 4 f |4q, I I I |iq 2 I I 2 + \ I l*q 2 I | J ♦ \ (i^j) < c * ^ 


For -J sufficiently small, 3 n >0 9UC |, t hac 

V I - Oj I |Aq t | | 2 - » 2 I |Aq 2 i | 2 + c(^- + I 1^ I I I I ^ I 1 2 + \ I I ^q 2 I | J ♦ 0 


By Lemma 2-2, If V Q >0 and <^ t 5j are small, the system remains Lagrange stable and the ultimate bound 
vanishes as ^ , ^5 ^ 0. Hence, the design is Insensitive with respect to modeling errors. For robust 
design for a given level of modeling uncertainties, GminCKy) and v should be large enough. 

Finally, suppose bounded errors *2 and c-j are incurred in qp q 2 and u, respec t ively . Control 
laws (4. 2) are now in the form 


jU* , 

u • - “v ^2 * Ta^ (4 V * k( V + M <V q 2 d ' D<q 1 .q 2 * q 2 d ) + 4 1 + 4 2 

Follow the same steps as before, we overbound Che extra terms in V by sums of || £iq ^|| 2 , ]|Aq 2 || 2 , ||Aq || ||Aq 2 || 2 

and constant terms. Again use Lemma 2-2 to conclude that the controller is Insensitive to^bounded Instrument 
noises and robust for a given level of noise if a m ^ n ^ v ^ an< * v are sufficiently large. 

As an aside, it should be noted that similar results as derived here hold for computed torque 
techniques also. For the case of set point control under friction, the insensitivity and robustness 
properties of the design here do not follow directly from the analysis. 

There are obviously many more practical implementation issues not addressed here: sampling effect, 

actuator saturation. Joint and arm flexibilities and instrument dynamics. They are currently under 
invest isac Ion in the same framework. 

5. Summary 


We have introduced a new class of exponentially stabilizing control laws for the joint level control of 
robot manipulators (summarized in Table I). The stability result is achieved by making use of a particular 
class of energy-like Lyapunov functions (of the form (4.4)) in conjunction with a useful lemma (Lemma 2-1) for 
addressing higher order terms in Lyapunov function derivatives. This approach avoids the need for a generali- 
zation of the invariance principle to time-varying systems, which has been the major source of difficulty in 
the past [9,10). 

In the set point control case, by incorporating artificial potential fields in the Lyapunov function, we have 
derived a class of exponentially stabilizing, PD + potential shaping type of control laws. Several useful 
potential fields have been examined resulting in simple structures: PD and PIHbias, and the ability to handle 
joint scop constraints with PD + joint-stop-barrier controller. 
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In th« tracking control can*, the modified Lyapunov function leada to a nev claaa of exponantlally liable 
control lavs. This class of control laws offers sn alternative to the convertlonal computed torque method and 
provides trade-offs between on-line computation (which directly relates to performance through aaxlaua sampling 
rate) and condition for stability. In one new design, (4.8), the nonlinear structure la decoupled from the 
real-time measurements which completely removes the requirement for on-line nonlinear computation. The chart 
below illustrates the trade-offs In the various tracking control laws. 


On-line 
Computat ion 
Load 


(4.2a) 
(4.2b) 
(4.2c) 
(4. 2d) 


computed 

torque 


(4.6) 


(4.7) 


(4.8) 


v.K v 0 
for any 
initial 
condition 


v>0 

K „ large enough 
(Independent of 
Initial condition 


K v large enough 
for a given sec 
of Initial 
cond It Ions 


v.*v 

large enough 
for a given set 
of initial 
conditions 


The framework of Lyapunov stability analysis also allows robustness Issues to be directly addressed. 
Specifically, Insensitivity property (preservation of stability under small perturbation) and condition for 
robust design (preservation of stability under a specified amount of perturbation) for this new class of 
controllers have been derived with respect to viscous and Coulomb friction, modeling error and bounded 
Instrument noise. 

The new stability analysis and controller design teqhnlques presented in chls paper open up many promising 
avenues for future research. In particular, our current research directions Include: ways to Incorporate time- 

varying artificial potential fields In the tracking problem ana Che generalization of the exponentially 
stabilizing jolnc-level control laws to the task space. 
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